基于Zigbee技術(shù)的全方位移動機(jī)器人本體設(shè)計
2014/2/8 14:23:05
1.引言
1998年日本東京大學(xué)井上研究所提出的“遠(yuǎn)程腦”[1-2]概念,是移動機(jī)器人控制體系結(jié)構(gòu)的進(jìn)步。近年來,移動機(jī)器人的應(yīng)用領(lǐng)域和應(yīng)用范圍正逐漸拓寬,全方位移動機(jī)器人由于具有平面運動的全部三個自由度,理論上可以在任何角度以任何速度在機(jī)器人所處平面上運動,因此具有廣闊的應(yīng)用前景和良好的社會效益。本文在遠(yuǎn)程腦的基礎(chǔ)上,提出了遠(yuǎn)程小腦的概念,將遠(yuǎn)程腦概念分為遠(yuǎn)程大腦和遠(yuǎn)程小腦兩部分。遠(yuǎn)程大腦同樣安裝在機(jī)器人體外,遠(yuǎn)程小腦則安裝在機(jī)器人體內(nèi),兩者之間以及機(jī)器人之間采用Zigbee模塊構(gòu)建通訊網(wǎng)絡(luò)。這樣,遠(yuǎn)程大腦控制遠(yuǎn)程小腦,向遠(yuǎn)程小腦下達(dá)各項指令和命令,再由遠(yuǎn)程小腦控制機(jī)器人體內(nèi)的各個功能模塊,指揮機(jī)器人完成各項任務(wù),并且機(jī)器人之間可以通過Zigbee組網(wǎng),實現(xiàn)信息交換和資源共享。
2.全方位移動機(jī)器人本體設(shè)計
基于遠(yuǎn)程腦的類人機(jī)器人本體采用模塊化設(shè)計,其結(jié)構(gòu)框圖如圖1所示,包括智能模塊(小腦)、無線通訊模塊、機(jī)械手控制及驅(qū)動模塊、車體運動控制及驅(qū)動模塊、傳感器信號采集及處理模塊、語音模塊等。
圖1機(jī)器人本體結(jié)構(gòu)框圖
2.1無線通訊模塊
由于機(jī)器人大小腦分離,且機(jī)器人有一定的活動范圍,因此,本設(shè)計采用無線通信模塊進(jìn)行遠(yuǎn)程大腦和機(jī)器人小腦之間的信息傳輸,省掉了通信線纜,便于機(jī)器人移動。遠(yuǎn)程大腦處理操作者的命令,并將處理后的控制指令進(jìn)行編碼后,通過無線傳輸模塊發(fā)送到小腦,小腦接收命令后,經(jīng)過分析、判斷,將分解的指令傳送至各運動模塊的控制器,同時小腦將采集的各種信息編碼后通過無線通訊模塊傳送至大腦??紤]到遠(yuǎn)程大腦和小腦之間命令傳輸?shù)臏?zhǔn)確性、快速性以及通訊距離的遠(yuǎn)近等要求,本設(shè)計選用了Chipcon公司的基于ZigBee協(xié)議的CC2420EM射頻模塊。ZigBee是一種新型的短距離無線接入技術(shù),與藍(lán)牙相比,它具有低成本、低功耗、組網(wǎng)方便、可實現(xiàn)自路由功能和數(shù)據(jù)的可靠傳輸?shù)葍?yōu)點。CC2420是Chipcon公司推出的首款基于ZigBee技術(shù)的射頻收發(fā)器。它只需極少數(shù)外部元器件,性能穩(wěn)定且功耗極低,可確保短距離通信的有效性和可靠性。利用此芯片開發(fā)的無線通信設(shè)備支持?jǐn)?shù)據(jù)傳輸率高達(dá)250kbps,可以實現(xiàn)多點對多點的快速組網(wǎng)。CC2420EM模塊集成了CC2420及其所需的外圍電路。機(jī)器人小腦與射頻模塊的具體接口電路如圖2所示。單片機(jī)通過4線SPI總線(STE1、SIMO1、SOMI1、UCLK1)控制和設(shè)置芯片的工作模式,并實現(xiàn)讀/寫緩存數(shù)據(jù),讀/寫狀態(tài)寄存器等。通過控制FIFO和FIFOP引腳接口的狀態(tài)可設(shè)置發(fā)射/接收緩存器,F(xiàn)IFOP引腳必須連接到單片機(jī)的中斷引腳。通過CCA引腳狀態(tài)可以得到空閑信道估計。通過SFD引腳狀態(tài)可以得到發(fā)射幀和接收幀的定時信息從而判斷系統(tǒng)的工作狀態(tài),SFD引腳應(yīng)該接到單片機(jī)的時鐘捕捉引腳。
圖2單片機(jī)與CC2420的接口電路
2.2車體運動控制及驅(qū)動模塊
本文所研究的行走載體,由麥卡納姆輪系(Mecanumwheels)構(gòu)成。麥卡納姆輪系是移動機(jī)器人中常用的全方位移動機(jī)構(gòu),它可沿任意平面方向靈活運動,尤其具有左右橫移和原地僅以自身半徑轉(zhuǎn)動的獨一無二的功能[6-7]。
車體采用四輪移動機(jī)構(gòu),四個麥卡納姆車輪分別由四個直流電機(jī)獨立驅(qū)動,通過對這四個電機(jī)轉(zhuǎn)速的控制,就可以實現(xiàn)其橫向、縱向、繞自身中心旋轉(zhuǎn)以及斜向等移動。每個麥卡納姆車輪由兩部分組成:主動的輪轂和輪轂外緣按一定傾斜方向均勻分布的多個被動滾輪組成。
圖3麥卡納姆車輪結(jié)構(gòu)與速度示意圖
該機(jī)器人運動控制的核心為一塊Atmega128。每個麥卡納姆車輪由一臺直流電機(jī)配合減速器獨立驅(qū)動,每個電機(jī)由4個功率器件VMOS(IRLZ44N)組成橋式電路,為了獲得較好的動態(tài)性能和低速的平穩(wěn)性,故采用H型PWM調(diào)速方式,同時實現(xiàn)了正、反轉(zhuǎn)運行以及制動。
2.3機(jī)械手控制及驅(qū)動模塊
機(jī)械手部分采用專門的兩塊模塊分別控制兩個機(jī)械手。驅(qū)動模塊控制機(jī)械手的動作,位姿檢測裝置實時檢測動作關(guān)節(jié)的位置與姿態(tài),反饋給小腦,小腦判斷是否完成用戶指令。當(dāng)沒有完成用戶指令時,繼續(xù)執(zhí)行用戶指令;當(dāng)已經(jīng)完成用戶指令時,機(jī)器人小腦通過無線傳輸模塊通知遠(yuǎn)程腦已經(jīng)完成用戶指令。
2.4傳感器信號采集及處理模塊
對于機(jī)器人而言,傳感器就像它的眼、耳、鼻,能夠幫助機(jī)器人正確分辨它所處的環(huán)境,為機(jī)器人順利完成自己的工作提供幫助。傳感器的數(shù)量和種類很多,本文根據(jù)設(shè)計需要,采用了探底光電傳感器、探邊光電傳感器和超聲波測距傳感器。機(jī)器人上所有傳感器由一單獨的單片機(jī)進(jìn)行控制采集,并通過小腦實時向上位機(jī)發(fā)送信息。當(dāng)上位機(jī)發(fā)出指令使機(jī)器人向某個方向運動時,會同時發(fā)給傳感器模塊對應(yīng)信息,則傳感器模塊會查詢對應(yīng)方向的傳感器信號,并及時將其反饋給上位機(jī)進(jìn)行處理,當(dāng)出現(xiàn)緊急情況,如將要撞到墻壁或物體,則傳感器模塊會首先發(fā)給車體控制模塊一個中斷信號,使其停車,然后再反饋上位機(jī)進(jìn)行處理,并繼續(xù)查詢。各傳感器有效距離如表1所示。
表1所用傳感器的有效距離
2.5語音模塊
從人性化設(shè)計方面考慮,本設(shè)計增加了語音模塊,這樣在遇到人員阻擋或者是遇到障礙的時候,機(jī)器人可以根據(jù)上位機(jī)指令要求或外部輸入信號發(fā)出的要求,通過語言模塊發(fā)出警報,通知操作者或提示障礙源,從而避免發(fā)生事故。機(jī)器人語音模塊結(jié)構(gòu)如圖4所示。
圖4語音模塊結(jié)構(gòu)框圖圖5全方位移動機(jī)器人實物圖
3.實驗研究及分析
全方位移動機(jī)器人的樣機(jī)如圖5所示。經(jīng)行駛試驗,全方位移動機(jī)器人可以實現(xiàn)前、后、左、右、左前、右前、左后、右后、逆時針、順時針的平穩(wěn)運動。直線行駛具有良好的線性度,原地旋轉(zhuǎn)任意角度后,位置誤差較小。由于該機(jī)器人采用的電機(jī)為帶減速箱的減速電機(jī),故其在小角度斜平面上可以自鎖停滯,也可以慢速移動。機(jī)器人運動靈活平穩(wěn),且運動不受限于所處工作空間,可使其應(yīng)用范圍更為廣泛。但由于未考慮的總體重量以及外形尺寸,機(jī)器人的體積與重量還有變化的空間。
4.總結(jié)
本文在“遠(yuǎn)程腦”的基礎(chǔ)上,提出了“遠(yuǎn)程小腦”的概念,二者之間采用Zigbee技術(shù)進(jìn)行通信,并采用Mecanum式全向移動輪及模塊化設(shè)計方法,實現(xiàn)了全方位移動機(jī)器人的本體設(shè)計,最大限度地提高了機(jī)器人的自主性。由于該機(jī)器人具有無線通訊、全方位移動、自動避障和機(jī)器手夾取等功能,因此可以用于很多路面相對平坦的工作場合,而且以此機(jī)器人為平臺,可以開發(fā)出更先進(jìn)更完善的機(jī)器人。
1998年日本東京大學(xué)井上研究所提出的“遠(yuǎn)程腦”[1-2]概念,是移動機(jī)器人控制體系結(jié)構(gòu)的進(jìn)步。近年來,移動機(jī)器人的應(yīng)用領(lǐng)域和應(yīng)用范圍正逐漸拓寬,全方位移動機(jī)器人由于具有平面運動的全部三個自由度,理論上可以在任何角度以任何速度在機(jī)器人所處平面上運動,因此具有廣闊的應(yīng)用前景和良好的社會效益。本文在遠(yuǎn)程腦的基礎(chǔ)上,提出了遠(yuǎn)程小腦的概念,將遠(yuǎn)程腦概念分為遠(yuǎn)程大腦和遠(yuǎn)程小腦兩部分。遠(yuǎn)程大腦同樣安裝在機(jī)器人體外,遠(yuǎn)程小腦則安裝在機(jī)器人體內(nèi),兩者之間以及機(jī)器人之間采用Zigbee模塊構(gòu)建通訊網(wǎng)絡(luò)。這樣,遠(yuǎn)程大腦控制遠(yuǎn)程小腦,向遠(yuǎn)程小腦下達(dá)各項指令和命令,再由遠(yuǎn)程小腦控制機(jī)器人體內(nèi)的各個功能模塊,指揮機(jī)器人完成各項任務(wù),并且機(jī)器人之間可以通過Zigbee組網(wǎng),實現(xiàn)信息交換和資源共享。
2.全方位移動機(jī)器人本體設(shè)計
基于遠(yuǎn)程腦的類人機(jī)器人本體采用模塊化設(shè)計,其結(jié)構(gòu)框圖如圖1所示,包括智能模塊(小腦)、無線通訊模塊、機(jī)械手控制及驅(qū)動模塊、車體運動控制及驅(qū)動模塊、傳感器信號采集及處理模塊、語音模塊等。
圖1機(jī)器人本體結(jié)構(gòu)框圖
2.1無線通訊模塊
由于機(jī)器人大小腦分離,且機(jī)器人有一定的活動范圍,因此,本設(shè)計采用無線通信模塊進(jìn)行遠(yuǎn)程大腦和機(jī)器人小腦之間的信息傳輸,省掉了通信線纜,便于機(jī)器人移動。遠(yuǎn)程大腦處理操作者的命令,并將處理后的控制指令進(jìn)行編碼后,通過無線傳輸模塊發(fā)送到小腦,小腦接收命令后,經(jīng)過分析、判斷,將分解的指令傳送至各運動模塊的控制器,同時小腦將采集的各種信息編碼后通過無線通訊模塊傳送至大腦??紤]到遠(yuǎn)程大腦和小腦之間命令傳輸?shù)臏?zhǔn)確性、快速性以及通訊距離的遠(yuǎn)近等要求,本設(shè)計選用了Chipcon公司的基于ZigBee協(xié)議的CC2420EM射頻模塊。ZigBee是一種新型的短距離無線接入技術(shù),與藍(lán)牙相比,它具有低成本、低功耗、組網(wǎng)方便、可實現(xiàn)自路由功能和數(shù)據(jù)的可靠傳輸?shù)葍?yōu)點。CC2420是Chipcon公司推出的首款基于ZigBee技術(shù)的射頻收發(fā)器。它只需極少數(shù)外部元器件,性能穩(wěn)定且功耗極低,可確保短距離通信的有效性和可靠性。利用此芯片開發(fā)的無線通信設(shè)備支持?jǐn)?shù)據(jù)傳輸率高達(dá)250kbps,可以實現(xiàn)多點對多點的快速組網(wǎng)。CC2420EM模塊集成了CC2420及其所需的外圍電路。機(jī)器人小腦與射頻模塊的具體接口電路如圖2所示。單片機(jī)通過4線SPI總線(STE1、SIMO1、SOMI1、UCLK1)控制和設(shè)置芯片的工作模式,并實現(xiàn)讀/寫緩存數(shù)據(jù),讀/寫狀態(tài)寄存器等。通過控制FIFO和FIFOP引腳接口的狀態(tài)可設(shè)置發(fā)射/接收緩存器,F(xiàn)IFOP引腳必須連接到單片機(jī)的中斷引腳。通過CCA引腳狀態(tài)可以得到空閑信道估計。通過SFD引腳狀態(tài)可以得到發(fā)射幀和接收幀的定時信息從而判斷系統(tǒng)的工作狀態(tài),SFD引腳應(yīng)該接到單片機(jī)的時鐘捕捉引腳。
圖2單片機(jī)與CC2420的接口電路
2.2車體運動控制及驅(qū)動模塊
本文所研究的行走載體,由麥卡納姆輪系(Mecanumwheels)構(gòu)成。麥卡納姆輪系是移動機(jī)器人中常用的全方位移動機(jī)構(gòu),它可沿任意平面方向靈活運動,尤其具有左右橫移和原地僅以自身半徑轉(zhuǎn)動的獨一無二的功能[6-7]。
車體采用四輪移動機(jī)構(gòu),四個麥卡納姆車輪分別由四個直流電機(jī)獨立驅(qū)動,通過對這四個電機(jī)轉(zhuǎn)速的控制,就可以實現(xiàn)其橫向、縱向、繞自身中心旋轉(zhuǎn)以及斜向等移動。每個麥卡納姆車輪由兩部分組成:主動的輪轂和輪轂外緣按一定傾斜方向均勻分布的多個被動滾輪組成。
圖3麥卡納姆車輪結(jié)構(gòu)與速度示意圖
該機(jī)器人運動控制的核心為一塊Atmega128。每個麥卡納姆車輪由一臺直流電機(jī)配合減速器獨立驅(qū)動,每個電機(jī)由4個功率器件VMOS(IRLZ44N)組成橋式電路,為了獲得較好的動態(tài)性能和低速的平穩(wěn)性,故采用H型PWM調(diào)速方式,同時實現(xiàn)了正、反轉(zhuǎn)運行以及制動。
2.3機(jī)械手控制及驅(qū)動模塊
機(jī)械手部分采用專門的兩塊模塊分別控制兩個機(jī)械手。驅(qū)動模塊控制機(jī)械手的動作,位姿檢測裝置實時檢測動作關(guān)節(jié)的位置與姿態(tài),反饋給小腦,小腦判斷是否完成用戶指令。當(dāng)沒有完成用戶指令時,繼續(xù)執(zhí)行用戶指令;當(dāng)已經(jīng)完成用戶指令時,機(jī)器人小腦通過無線傳輸模塊通知遠(yuǎn)程腦已經(jīng)完成用戶指令。
2.4傳感器信號采集及處理模塊
對于機(jī)器人而言,傳感器就像它的眼、耳、鼻,能夠幫助機(jī)器人正確分辨它所處的環(huán)境,為機(jī)器人順利完成自己的工作提供幫助。傳感器的數(shù)量和種類很多,本文根據(jù)設(shè)計需要,采用了探底光電傳感器、探邊光電傳感器和超聲波測距傳感器。機(jī)器人上所有傳感器由一單獨的單片機(jī)進(jìn)行控制采集,并通過小腦實時向上位機(jī)發(fā)送信息。當(dāng)上位機(jī)發(fā)出指令使機(jī)器人向某個方向運動時,會同時發(fā)給傳感器模塊對應(yīng)信息,則傳感器模塊會查詢對應(yīng)方向的傳感器信號,并及時將其反饋給上位機(jī)進(jìn)行處理,當(dāng)出現(xiàn)緊急情況,如將要撞到墻壁或物體,則傳感器模塊會首先發(fā)給車體控制模塊一個中斷信號,使其停車,然后再反饋上位機(jī)進(jìn)行處理,并繼續(xù)查詢。各傳感器有效距離如表1所示。
表1所用傳感器的有效距離
2.5語音模塊
從人性化設(shè)計方面考慮,本設(shè)計增加了語音模塊,這樣在遇到人員阻擋或者是遇到障礙的時候,機(jī)器人可以根據(jù)上位機(jī)指令要求或外部輸入信號發(fā)出的要求,通過語言模塊發(fā)出警報,通知操作者或提示障礙源,從而避免發(fā)生事故。機(jī)器人語音模塊結(jié)構(gòu)如圖4所示。
圖4語音模塊結(jié)構(gòu)框圖圖5全方位移動機(jī)器人實物圖
3.實驗研究及分析
全方位移動機(jī)器人的樣機(jī)如圖5所示。經(jīng)行駛試驗,全方位移動機(jī)器人可以實現(xiàn)前、后、左、右、左前、右前、左后、右后、逆時針、順時針的平穩(wěn)運動。直線行駛具有良好的線性度,原地旋轉(zhuǎn)任意角度后,位置誤差較小。由于該機(jī)器人采用的電機(jī)為帶減速箱的減速電機(jī),故其在小角度斜平面上可以自鎖停滯,也可以慢速移動。機(jī)器人運動靈活平穩(wěn),且運動不受限于所處工作空間,可使其應(yīng)用范圍更為廣泛。但由于未考慮的總體重量以及外形尺寸,機(jī)器人的體積與重量還有變化的空間。
4.總結(jié)
本文在“遠(yuǎn)程腦”的基礎(chǔ)上,提出了“遠(yuǎn)程小腦”的概念,二者之間采用Zigbee技術(shù)進(jìn)行通信,并采用Mecanum式全向移動輪及模塊化設(shè)計方法,實現(xiàn)了全方位移動機(jī)器人的本體設(shè)計,最大限度地提高了機(jī)器人的自主性。由于該機(jī)器人具有無線通訊、全方位移動、自動避障和機(jī)器手夾取等功能,因此可以用于很多路面相對平坦的工作場合,而且以此機(jī)器人為平臺,可以開發(fā)出更先進(jìn)更完善的機(jī)器人。
提交
查看更多評論
其他資訊
工業(yè)機(jī)器人控制系統(tǒng)的開放體系結(jié)構(gòu)
工業(yè)機(jī)器人離線編程及無碰撞路徑規(guī)劃系統(tǒng)的開發(fā)研究
工業(yè)機(jī)器人手臂結(jié)構(gòu)的有限元分析與研究
工業(yè)機(jī)器人通用控制器研究開發(fā)
工業(yè)機(jī)器人網(wǎng)絡(luò)控制與編程